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ABSTRACT 


This  work  addresses  the  design  end  analysis  of  the  discrete  longitudinal 
autopilot  for  application  to  the  bank-to*tum  (BTT)  missiles. 

in  the  development  the  classical  design  and  analysis  were  reviewed 
using  the  continuous  uncoupled  pitch  channel  autopilot  for  circular  airframe. 
Then.applying  analog-to-digital  conversion,  the  corresponding  discrete 
autopilot  was  designed.  The  performance  of  both  continuous  and  discrete 
open  loop  systems  was  analyzed  according  to  the  desired  requirements. 

in  the  following  section,  utilizing  modem  control  design  techniques  for 
the  discrete  pitch  channel  autopilot,  the  control  law  was  designed, 
assuming  availability  of  all  the  states  and  taking  the  desired  poles  to  be  at 
the  same  place  as  in  the  classical  design.  Therefore  the  discrete  state* 
feedback  autopilot  was  obtained  and  analyzed.  The  next  step  was  the  design 
of  an  estimator  which  estimates  the  entire  state  vector,  given 
measurements  of  the  portion  of  the  state.  The  performance  of  the  estimator 
was  analyzed  too. 

Finally  coupling  the  discrete  pitch  and  roll  channel  autopilots  the 
overall  performance  of  the  discrete  system  was  obtained  and  analyzed.  The 
resulting  design  was  also  proved  to  be  robust. 
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Missile  systems  designed  to  meet  the  threat 'r  of  the  future  will  require 
capabilities  far  beyond  of  those  currently  available.  Future  requirements 
dictate  the  need  for  dramatic  Increases  In  Short  Range  Alr-to-AIr  Missile 
(SRAAM)  maneuverability  and  guidance  accuracy.  Many  current  missile 
designs,  which  are  characterized  by  cruciform  airframes  and  skid-to-tum 
(STT)  steering,  cannot  be  extended  to  meet  these  requirements  due  to  low 
aerodynamic  efficiency.  Bank-to-tum  steering  provides  the  capability  to 
design  asymmetric  missile  airframes  which  optimize  aerodynamic 
performance  In  one  plane  and  thus  obtain  the  SRAAM  maneuverability  and 
accuracy  requirements.  Furthermore  the  ramjet  engine  chin  Inlet 
configuration  Is  believed  to  provide  a  greater  range  capability  than  other 
Inlet  configurations,  and  BBT  control  Is  required  to  satisfy  the  sideslip 
constraints  Imposed  by  chin  Inlets. 

In  addition,  to  Its  potential  advantages,  BBT  steering  Introduces  some 
technical  concerns  which  must  be  carefully  evaluated.  For  example,  the 
methodology  for  designing  a  bank-to-tum  autopilot  is  not  well  developed. 
Such  a  design  must  take  Into  account  the  aerodynamic  and  kinematic 
coupling  terms  as  well  as  allow  for  operation  a  low  signal  levels  (I.e,  small 
angle  of  attack)  when  the  preferred  roll  orientation  Is  poorly  defined.  In 
addition,  the  coupling  of  body  motion  Into  the  guidance  signals  Is  another 
major  concern  for  BBT  systems.  Recent  analyses  have  Indicated  that  some 
skid-to-tum  (STT)  systems  can  tolerate  a  limited  amount  of  radome- 


induced  instabilities  without  severe  performance  degradation  (Ref.ll.  In  a 
BBT  system  a  coupling  loop  is  closed  through  roll  rate  as  well  as  pitch  and 
yaw  rates  [Ref.2].  It  is  not  known  whether  BBT  systems  can  tolerate 
coupling  induced  instabilities.  Another  concern  is  the  interaction  of  BBT 
control  with  missile  functions  such  as  detection  (seeker),  guidance  signal 
processing  ^control  surface  effectiveness,  etc. 

All  the  above  concerns  must  be  investigated  before  BBT  steering  can  be 
considered  a  viable  method  to  control  high  performance  tactical  missiles. 

Many  missile  programs  were  initiated  during  the  past  decade  to 
improve  the  capability  of  steering  a  tactical  missile  via  BTT  control.  The 
results  have  greatly  advanced  the  understanding  of  the  various  missile 
subsystems. 

in  the  autopilot  area,  specifically,  many  types  of  autopilots  hove  been 
found  which  force  the  missile  to  roll  or  bank  so  that  the  steering  maneuver 
occurs  with  the  missile  airframe  oriented  in  a  specific  or  preferred 
direction  with  respect  to  the  incoming  oirsteam.  This  entire  class  of 
autopilots  referred  to  as  Preferred  Orientation  Control  (POC)  autopilots. 

The  main  criterion  for  the  selection  of  one  particular  type  of  autopilot 
is  based  upon  the  guidance,  airframe,  and  propulsion  system  requirements. 
Generally  missiles  with  either  one  or  two  planes  of  symmetry  use  a  POC 
autopilot  which  forces  the  missile  to  bank  in  order  to  turn  (BTT)  like  an 
aircraft,  and  if  this  motion  is  coordinated  it  is  usually  referred  to  as  CBTT. 

In  order  to  take  full  advantage  of  CBTT  control,  planar  airframes  have 
been  designed  to  increase  lifting  capability  in  one  direction  without  the 
weight  and  drag  penalty  associated  with  orthogonal  lifting  surfaces  [Ref.ll. 


II  III^  I"'  .■  V. 


These  airframe  have  aerodynamic  properties  which  hove  the  potential  to 
enhance  CBTT  control. 

The  present  work  addresses  the  design  and  analysis  of  the  discrete 
pitch  channel  autopilot  for  application  to  the  bank-to-tum  (BTT)  missiles, 
with  circular  airframe  configuration.  The  circular  airframe  is  chosen 
because  It  Is  stable  for  all  angles  of  attack. 

In  the  development  the  classical  design  and  analysis  of  the  uncoupled 
pitch  channel  autopilot  as  were  developed  In  reference  [Ref .3],  are  reviewed. 
Using  state-space  representation  a  tenth  order  system  Is  formulated  and 
the  Step  Response,  Bode  and  Pole-Zero  Map  plots  are  obtained  and  analyzed 
according  to  the  desired  requirements.  Then  the  continuous  system  is 
converted  into  the  corresponding  discrete  system  using  Analog  to  Digital 
conversion  from  ORACLS,  and  analyzed  according  to  the  Step-Response,and 
Pole-Zero  hap  plots  obtained.  A  comparison  of  the  plots  of  both  the 
continuous  and  discrete  systems  shows  no  significant  differences. 

Next,  utilizing  modem  control  design  techniques  and  assuming  that  we 
have  all  the  states  at  our  disposal  for  feedback  purposes,  the  control  law  is 
designed  using  the  Ackermann's  formula  [Ref.  6]  and  taking  the  desired  poles 
to  be  at  the  same  place  as  In  the  classical  case.  Using  the  control  law  gains 
the  discrete  state-feedback  autopilot  is  designed  and  the  Step  Response, and 
Pole-Zero  hap  plots  are  obtained  and  analyzed.  Then,  since  we  usually  know 
only  a  portion  of  the  state  variables,  an  estimator  Is  Introduced  In  order  to 
estimate  the  entire  state  vector  given  measurements  of  that  portion.  The 
poles  of  the  estimator  are  moved  to  the  left  of  the  original  poles  of  the 
system  In  order  to  get  faster  response.  Plots  as  above  are  obtained  and  an 
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analysis  is  mode.  Next  the  designed  discrete  pitch  chonnel  autopilot  is 
coupled  with  the  discrete  roll  channel  autopilot  and  the  whole  discrete 
system  is  analysed  and  proved  to  be  robust.  Finally  conclusions  and 
recommendations  for  future  study  are  stated. 

The  analysis  in  all  the  above  cases  was  performed  using  the  existing  at 
NFS  Optimal  Systems  Control  Program  (OPTSYS)  for  the  continuous  system. 
Optimal  Regulator  Algorithms  for  the  Control  of  Linear  Systems  (ORACLS) 
for  the  discrete  system,  and  Pole  Placement  and  Robustness  Design  Program 
(POPLAR)  for  the  robustness  of  the  discrete  system. 


A.  GENERAL 


The  Initial  phase  In  the  design  of  the  CBTT  autopilot  Involved  the  design 
of  Individual,  uncoupled  channels,  pitch,  yaw,  and  roll,  with  prescribed 
relationships  between  speeds  of  response  which  would  meet  the  CQTT 
requirements  when  coupled. 

The  design  technique  for  the  uncoupled  pitch  channel  was  classical,  using 
a  combination  of  Frequency  Response  and  Root  Locus  techniques  [Ref.  2],  to 
achieve  practical  bandwidths  and  In  turn  provide  the  range  of  required 
missile  body  angular  rates  and  control  motions.  In  addition,  the  resulting 
design  Is  found  to  be  robust. 

The  whole  design  was  done  for  a  flight  condition  at  n=3.95  and 
Alt1tude=60  KFT. 

The  requirements  for  the  classical  design  technique,  as  stated  In 
(Ref.  21  are: 

1.  HlohJceguencu  Attenuation  In  Actuator  Command  Branch 

>  15  dB  at  100  rad/sec  and  zero  angle-of-attack.  This  requirement 
limits  autopilot  speeds  of  response. 

2.  Relative  Stability: 

Gain  margins  i  6  dB,  Phase  margins  i  30  degrees  with  a  goal  of 


12  dB  and  50  degrees. 


a.  63  percent  time  constant  of  0.5  seconds  for  a  step  command  of 
acceleration  at  the  flight  condition  of  interest  (M=3.95,  Alt1tude=60  KFT) 
and  small  angle  of  attack.  This  response  Is  representative  of  a  tactical 
missile  of  this  size. 

b.  Overshoot  <  10  percent. 

c.  Zero  steady  state  error  In  acceleration  to  reduce  variations  of 
guidance  navigation  gain. 

In  this  chapter  the  airframe  configuration,  the  aerodynamic  model  and 
control  law  for  the  pitch  channel  are  reviewed.  The  transfer  functions  for 
circular  airframe  which  Is  stable  for  all  angles  of  attack  (Ref.  21,  are 
derived.  An  analysis  for  the  uncoupled  pitch  channel,  as  regards  the 
acceleration  response,  the  body  angular  rate  and  control  surface  deflection, 
In  terms  of  time  resposnes  and  pole-zero  map  plots  for  both  the  continuous 
and  discrete  system  and  frequency  responses  for  the  continuous  system,  Is 
made,  using  the  existing  at  NFS  Optimal  Systems  Control  Program  (OPTSYS) 
for  the  continuous  system,  and  Optimal  Regulator  Algorithms  for  the  Control 
of  Linear  Systems  (ORACLS)  for  the  discrete  system.  Finally  a  comparison  of 
the  continuous  and  discrete  system  by  analyzing  the  above  results  is  made. 

A  general  block  diagram  of  the  BTT  autopilot  Is  shown  In  Figure  2.1. 

B.  AIRFRAME  CONFIGURATION 

An  Investigation  has  been  conducted  by  NASA  [Ref.4]  to  compare  the 
experimental  aerodynamic  characteristics  of  a  low-drag  missile  concept 
with  a  body  of  circular  cross  section  to  one  with  a  body  of  3:1  elliptical 
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cross  section,  the  bodies  having  identical  cross  section  area  distributions. 
The  concepts  were  of  mono-wing  design  with  constant  wing  span.  Tall 
surfaces  were  located  flush  at  the  body  base  with  ±30  degrees  dihedral. 
Wind-tunnel  tests  were  performed  at  Mach  numbers  from  0.5  to  4.63  and  at 
angles  of  attack  from  about  -5°  to  +28  o. 

The  comparison  shows  no  significant  subsonic  normal  force  differences 
at  low  angles  of  attack;  however,  at  supersonic  speeds,  the  elliptical 
concept  Increasingly  provides  greater  normal  force  up  to  Mach  2.5  to  3.0, 
beyond  which  an  Incremental  Increase  of  about  25  percent  holds  through  the 
angle  of  attack  range.  More  pronounced  nonl  Inearl  ties  In  pitching  moment 
occur  at  subsonic  speed  for  the  elliptical  concept,  as  well  as  less 
longitudinal  stability  at  all  test  Mach  numbers.  However,  levels  of 
directional  and  lateral  stability  are  Increased,  especially  at  the  higher 
angles  of  attack. 

This  work  uses  the  circular  airframe  configuration  which  Is  shown  In 
Figure  2.2  and  It  Is  taken  from  [Ref.  4).  The  circular  cross  sectional  body  has 
a  closure  ratio  At^/A^ax  ond  the  A^ax  occurs  at  68  percent  body 

length. 

C.  UNCOUPLED  LINEAR  PITCH  CHANNEL  AUTOPILOT 
1.  Aerodunamtc  Model 

The  following  addresses  the  linear  design  and  analysis  of  the 
continuous  uncoupled  pitch  channel  autopilot  for  the  circular  airframe. 
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A  linearized  aerodynamic  model  was  developed  for  stability  studies. 
The  method  used  Is  an  extension  of  the  linearization  technique  used  for 
skid-to-tum  (STT)  aerodynamic  models. 

The  following  three  assumptions  were  made: 

a.  Plane  Xb-Fb  of  Figure  2.3  Is  the  maneuver  plane. 

b.  Missile  Is  trimmed  In  pitch  (I.e,  My=0,  at  fixed  values  of  a,  q,  and 
Sp). 

c.  Missile  roll  rate  Is  constant. 

The  resulting  model  Is  shown  In  block  diagram  form  In  Figure  2.4. 

Aerodynamic  stability  derivatives  for  M=3.95  are  provided  in  Table  I. 

2.  Pitch  Control  Law 

The  pitch  control  law  for  the  circular  airframe  is  shown  in  Figure  2.5 
as  given  In  (Ref.  21.  Lag-leads  were  used  to  prevent  guidance  noise 
saturation  problems.  The  rate  error  compensation  determines  the  high 
frequency  attenuation  and  was  used  to  minimize  the  effect  of  aerodynamic 
variations  on  acceleration  time  response.  The  acceleration  error 
compensation  determines  the  acceleration  time  response.  An  Integrator  was 
used  In  the  acceleration  error  branch  to  satisfy  the  guidance  requirement  of 
zero  steady-state  error. 

A  normal  acceleration  command  (nzc)  equal  to  I  gee  Is  applied  to  the 

pitch  control  law  which  uses  measurements  of  missile  body  pitch  angular 
rate  (q)  and  pitch  normal  acceleration  (n^)  to  determine  the  required 
actuator  command  (5po).  The  actuator  Is  modeled  as  a  first  order  lag  at 
188.4  rad/sec  (30  HZ)  and  Is  shown  In  Figure  2.6. 
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Figure  2.3  Aerodynamic  Sign  Convention. 
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Uncoupled  pitch  aerodynamic  transfer  functions  are 

Es 

- ♦  1 

q  k(AE-BC)  k(AE-BC) 

—  - - ,  deg/sec/deg  ( II.C.3- 1 ) 

-C  s2  A  k  s 

—  + - +  1 

-C  -C 


AE-BC  AE-BC 


s^  A  k  s 


g's/deg 


(II.C.3-2) 


qS  qS  (57.3)  qSd 

A  = - Cn,  ^  B  =  Cnj  p  C  s 

W  .  W 


(57.3)  qSd 


1845 


p  ,  ^  “ 


Where; 


V=Ma=3.95  X  960.47=  3825.46  ft/sec 

Ss  ir  ft2 

d=2  ft 

q=  1650  lb/ft2 

Ixx=  804  s1ug-ft2 

W=  2525  lbs 

Cm.  =  -0.06 

Cn,4  p=  -0.08 

Cn,  =0.15 
p  =  0.04 


As  referred  to  in  Appendix  A  and  Table  I. 


Then 

A  =0.30793 
8=0.08211 
C  = -44.33162 
E  = -59.10883 
k  =  0.48229 

And  substituting  the  aforementioned  values  Into  equations  (II.C.3-1) 
and  (II.C.3-2}  they  become; 


q  -1.3361  s- 0.159 

- - -  (1/sec)  (II.C.3-3) 

8p  22.545  X  1 0-3  s2  +  3.3634  x  1 0-3  s  ♦  1 


Oj  1 06.074  X  10-3  s2- 18.82 

- - -  (g's/rad)  ai.C.3-4) 

ap  22.545  X  10-3  s2  ♦  3.3634  x  10-3  s  ♦  1 


Equations  (II.C.3-3)  and  (II.C.3-4)  are  the  pitch  aerodynamic  transfer 
functions  for  the  pitch  angular  rate  (q)  about  the  Yg  and  the  achieved 
maneuver  acceleration  n^  In  the  Zg  direction. 

4.  Design  Approach  and  Analysis  of  the  Continuous  Open  Loop  Sustem 
A  fixed  flight  condition  at  60  KFT  altitude  and  M=3.95  was  selected 
for  these  preliminary  performance  studies  of  circular  airframe.  This  flight 
condition  provides  a  sufficiently  low  dynamic  pressure,  so  that  missile 
maneuvers  will  result  in  large  enough  angles-of-attack,  to  exercise  side 
slip  control.  The  above  fixed  condition  was  selected,  in  order  to  reduce  the 
complexities  of  C8TT  autopilots. 


The  analysis  of  the  uncoupled  pitch  channel  autopilot  is  based,  on  the 
time  responses,  and  Bode  plots  of  maneuver  plane  acceleration,  body  angular 
rates  and  tail  incidence  angles,  obtained  by  OPTSYS  control  program  of  NPS. 
For  that  reason  the  differential  equations  of  the  uncoupled  pitch  channel 
autopilot  must  be  put  in  state-space  form  X=FX-^6U,  which  is  obtained  as 
follows; 

a.  Equations  of  Control  Law 

(1)  Acceleration  Filter  Equation 

1 

X,= _ fij  (II.C.4-1) 

s 

- ♦  1 

150 

or 

Xt  S+ 150X,  =  ISOn*  (II.C.4-2) 

and  utilizing  inverse  Laplace  Transformation  it  becomes; 

X,  =-150Xi  ♦  150nj  (IIX.4-3) 

(2)  Acceleration  Compensator  Equation 


Y 


s  + 0.143 

(-0.0387)  - 

0.143 


(njc”X,)  s  (s  ♦  5) 


(II.C.4-4) 


5 

or  by  minor  manipulation 

Y  -0.27063  s  -0.0307 

- = -  (II.C.4-5) 

(Oje-X,)  0.2s2*s 


and  utilizing  inverse  Laplace  Transformation  it  becomes; 


Y+5Y=- 1 .353 1  (ri^e-X,  )-0. 1 935(njo-X, )  (II.C.4-6) 

Using  stale-space  representation  of  a  system,  In  which  the 
forcing  function  Involves  derivatives  terms  iRef.  5;  pp  675-678]  one  yields: 

X2=  X3- 1 .353 1  (rijc-X, )  (II.C.4-7) 

X3=-5X3+6.572(njo-Xi)  (II.C.4-8) 

V  =  X2  (II.C.4-9) 

(3)  Rate  Compensator  Equation 


(-  15.6) 


s  ♦  6.55 


6.55 


Spc  = 


(X2-X4) 


(II.C.4-10) 


S  ♦  0.M3 


0.143 


-2.3816  s-  15.6 

Spc  = - (X2-X4)  (II.C.4-11) 

6.993  s  ♦  1 


and  using  Inverse  Laplace  Transformation  It  yields: 
^=-0.1435p^-340.58  x  10-5(X2-X4)-2.2308(X2-X4)  (II.C.4-12) 
b.  Actuator  Equation 


1 

Sp  = -  Spc  (IIX.4-13) 

s+  188.4 


188.4 


and  using  Inverse  Laplace  Transformation  It  yields: 
^=-188.4  8p+188.4  8po 


(II.C.4-14) 


c.  Equations  of  Aerodynamic  Model 

From  aerodynamic  transfer  function,  Eq.  (II.C.3-3) 

q  -1.3361  s- 0.159 

- - - ,  or 

Sp  22.545  X  1 0-3  s2  ♦  3.3634  x  1 0-3  s  *  1 

22.545  X  1 0-3  qs2  + 3.3634  X  10-3  q  s  +  q  = -1.3361  8pS- 0.159  Sp 

(II.C.4-15) 

and  using  inverse  Laplace  Transformation  It  yields; 
q  +  1 49. 1 66 1 0-3  q  ♦  44.3557  q  =-59.2637  ^  -7.0526  Sp  (II.C.4- 1 6) 

Using  state-space  representation  of  a  system,  in  which  the  forcing 
function  Involves  derivatives  terms  (Ref.  5:  pp  675-6781  one  obtain; 

X4  =  Xg  -59.2637  Sp  (II.C.4- 1 7) 

Xg  =- 1 49. 1 86  X 1 0-3  Xg  -44.3557  X4  +  1 .7887  Sp  (II.C.4- 1 8) 

X4  =  q  (II.C.4- 19) 

From  aerodynamic  transfer  function  Eq.(II.C.3-4) 

rij  1 06.074  X  10-3  s2- 18.82 

- - -  ,  or 

Sp  22.545  X  1 0-3  s2  ♦  3.3634  x  1 0-3  s  +  1 

22.545  X 1 0-3  $2  rij  ♦  3.3634  x  1 0*3  s  n^  ♦  n^r  1 06.074  x  1 0-3  s2  Sp- 1 8.82Sp 

(II.C.4-20) 

or  +  1 49. 1 86  X  1 0-3  rij  +  44.3557  n^  =  4.705  -  834.775  Sp 

(II.C.4-21) 


and  proceeding  as  above  It  yields; 
)^  =  X7  -  701.92  X  IO-3Sp 


(II.C.4-22) 


X7  =  - 1 49. 1 86  X  1 0-3  X7  -  44.3557  -  1 043.36Sp  (II.C.4-23) 

nj  =  Xg  ♦  4.7056p  (II.C.4-24) 

Utilizing  state-space  representation,  all  the  aforementioned 
equations  con  be  modeled  in  a  tenth  order  system  os  follows; 


X,=  -150  X,  +  150X6  + 705.75  5p 

(II.C.4-25) 

X2  =  X3-  1.3531  n„+  1.3531  X, 

(II.C.4-26) 

X3  =  -5  X3  +  6.572  -  6.572  X, 

(II.C.4-27) 

X4  =  Xg  -  59.2637  6p 

ai.C.4-28) 

Xgr- 149. 1 86x10-3X5 -44.3557X4+  1.7887  5p 

(II.C.4-29) 

>^  =  X7  -  701.92  X  10-3  Sp 

(II.C.4-30) 

X7  = -149.186  X  10-3X7-44.3557X6-  1043.36  Sp 

(II.C.4-31) 

-188.4  Sp+  188.4  Spc 

(II.C.4-32) 

^  =  -0.143  6po  -2.2308  Xj  +  2.2308  X4  -340.58  x  10-3  X3  + 

+  460.839  X  1 0-3  n^c  -  460.839  x  1 0-3  X,  +  340.58  x  1 0-3  X5  - 


-20.184Sp  (II,C.4-33) 

rij  =  -(  X7  -  887. 1 24  Sp  +  886.422  )  (II.C.4-34) 

A  continuous,  linear,  constant  coefficient  system  of  differential 
equations,  os  above,  can  always  be  expressed  as  a  set  of  first-order  matrix 
differential  equations  X  =  FX+GU  where  U  is  the  control  input  to  the 
system.  The  output  can  be  expressed  as  a  linear  combination  of  the  state,  X, 
and  the  input  as  y=  HX>JU. 

The  state  method  of  representing  0  dynamic  system  is  very  useful 
because  it  standardizes  the  information  required  into  three  matrices,  F,  G, 
and  H,  no  matter  how  complicated  the  system  is. 

In  our  case  the  matrices  are; 


0  0  0  0 

0  0  0  0 

0  0  0  0 

-0.4608-2.231  -0.3406  2.231 
0  0  0  0 


0  0 
0  -44.36 
0  0 
0.3406  0 
0  0 


1  -0.7019 

■0.1492  -1043 
0 
0 


0 
0 

-188.4  188.4 
-20.18  -0.143 


-1  887.1  -886.4 


0 

0 

0 

0 

0 


The  stale-variables  of  interest  are: 

X4  =  q  :  pilch  angular  rate 

n^  :  pitch  normal  acceleration 

6p  ;  pitch  tail  incidence 

Utilizing  OPTSYS  the  tenth  order  system  was  analyzed  in  terms  of 
time  and  frequency  responses,  using  an  input  step  function  representing  the 
'1  gee  command"  and  trim  angle-of-attack  a,=0,  and  the  corresponding  plots 


were  obtained. 


Figure  2.7  shows  the  pitch  normal  acceleration  (n^)  response  which 
has  a  0.5  seconds  time  constant,  steady-state  error  0.005  and  2.0  % 
overshoot,  and  therefore  Is  according  to  the  requirements  mentioned  In 
section  II.A. 

Figures  2.8  and  2.9  show  the  required  body  angular  rate  (q)  and 
control  surface  deflection  (8p),  to  achieve  the  acceleration  response.  These 

responses  matched  those  presented  In  [Ref.  3]. 

Figures  2.10  through  2.15  show  the  frequency  responses  of  normal 
acceleration  (rie),  angular  rate  (q),  and  tall  Incidence  (Sp).  The  relative 
stability  margins  are  shown  in  Table  II,  Since  the  gain  and  phase  margins,  as 
shown  In  Table  II  are  positive,  It  ensures  that  the  closed  loop  (controlled) 
system  will  be  stable. 

Figures  2.16  through  2.18  show  the  Pole-Zero  Maps  of  n^,  q  and  Sp  The 


poles  locations  are  found  to  be  at: 

s,  =-159.7  + J  18.99  (Acceleration  Filter)  (II.C.4-35) 

S2  = -159.7  -  j  18.99  (Acceleration  Compensator)  (n.C.4-36) 

$3  =  -8.290  ♦  J  8.059  (II.C.4-37) 

S4  =  -8.290  -  J  8.059  (Angular  Rate)  (II.C.4-38) 

Sg  =-3.759  + j  2.515  (II.C.4-39) 

56  =-3.759- J  2.515  (II.C.4-40) 

57  =-0.14390000  (II.C.4-41) 

Se  =-0.000004251  (Actuator)  (II.C.4-42) 

S9  =  -0.07459  +  J  6.66  (Rate  Compensator)  (II.C.4-43) 

Sto  =  -0.07459  -  j  6.66  (Normal  Acceleration)  (II.C.4-44) 


sinse  all  poles  are  In  the  left-half  of  the  s-plane  the  system  Is  stable. 
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Figure  2.9  Pitch  Tall  Incidence  vs  Time;  Ucoupled  Pitch  Channel; 
Continuous  Open  Loop  System. 
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FREQUENCY  -  RADIANS  PER  SECOND 


Figure  2.10  Pilch  Normal  Acceleration;  Uncoupled  Pitch  Channel 
Continuous  Open  Loop  System;  Gain  vs  Frequency. 
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FREQUEN'CY  -  RADIANS  PER  SECOND 

Figure  2.13  Pitch  Angular  Rale;  Uncoupled  Pilch  Channel; 

Continuous  Open  Loop  System;  Phase  vs  Frequency 


1  V  a  J>i 


TABLE  II 


StabH1ti|  Margins  of  Uncoupled  Pitch  Channel 


q  nz 

Phase  Crossover  Frequency  (rad/s0c):  56.6896  -  57.2151 

Gain  Margin  (DB);  29.0988  -  7.5450 

Gain  Crossover  Frequency  (rad/sec):  5217.1016  -  375.9622 

Phase  Margin  (Degrees);  87.9482  -  62.9508 
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Figure  2.17  Pitch  Angular  Rote;  Uncoupled  Pilch  Channel; 

Continuous  Open  Loop  System,  Pole-Zero  Map. 


The  zeros  of  pitch  norma)  acceleration  are  found  to  be  at: 

Si  =-150.00 

(II.C.4-45) 

S2  =  13.32 

(II.C.4-46) 

S3  =-13.32 

(II.C.4-47) 

S4  =  -  6.550 

(II.C.4-48) 

Ss  =-0.000008758 

(II.C.4-49) 

S6  =  0.000004509 

(II.C.4-50) 

S7  =-0.1430 

(II.C.4-51) 

S9  =  -  0.07459  ♦  j  6.66 

(II.C.4-52) 

S9  =  -  0.07459  -  j  6.66 

(II.C.4-53) 

The  zeros  of  pitch  angular  rate  are  found  to  be  at: 

Si  =-150.00 

(II.C.4-54) 

S2  =-0.119 

(II.C.4-55) 

S3  =  0.001734 

(II.C.4-56) 

S4  =  -  6.550 

(II.C.4-57) 

S5  =-0.000867  + j  0.001516 

(II.C.4-58) 

$6  =-0.000867- j  0.001516 

(II.C.4-59) 

S7  =-0.1 430 

(II.C.4-60) 

Ss  =  -  0.07459  +  j  6.66 

(II.C.4-61) 

S9  =  -  0.07459  -  J  6.66 

(Il.C.4-62) 

The  zeros  of  pitch  toil  Incidence  are  found  to  be  ot: 

Si  =-150.00 

(II.C.4-63) 

S2  =-0.000001322 

(II.C.4-64) 

S3  =  -  6.550 

(II.C.4-65) 

S4  =  0.000001189 

(II.C.4-66) 

%  =- 0.07459  +  J  6.66  (II.C.4-68) 

S7  =  -  0.07459  -  j  6.66  (II.C.4-69) 

Se  =  -  0.07459  ♦  j  6.66  (II.C.4-70) 

S9  =  -  0.07459  -  J  6.66  (II.C.4-7 1 ) 

5.  Design  Approach  and  Analysis  of  the  Discrete  Open  Loop  Sqstem 

The  contro]  of  physical  systems  with  a  digital  computer  is  becoming 
more  and  more  common.  Many  new  digital  control  applications  are  being 
stimulated  by  microprocessor  technology.  Among  the  advantages  of  digital 
logic  for  control  are  the  increased  flexibility  of  the  control  programs  and 
the  decision-making  or  logic  capability  of  digital  systems  which  can  be 
shared  with  the  control  function  to  meet  other  system  requirements. 

In  order  to  compute  the  state  X(t)  by  use  of  a  digital  computer,  the 
continuous-time  state  equation  k  =  FX+GU  must  be  converted  into  the 
discrete-time  equation  k  =  AX*BU  ,  assuming  that  the  Input  vector  U 
changes  only  at  the  equally  spaced  sampling  instants  T. 

Utilizing  the  Analog-to-Digital  conversion  of  ORACLS  the  continuous 
time  matrices  F  and  6  were  converted  to  the  discrete  time  matrices  A  and 
B  using  sample  time  T=0.0125  sec  (Frequency:60  cps). 

The  computer  listing  of  the  above  conversion  is  shown  in  Appendix  B. 

The  TRANFUNC  option  of  ORACLS  was  used  to  analyze  the  dicrete  open 
loop  transfer  function  and  time  responses  and  pole-zero  maps  plots  were 


obtained  as  for  the  continuous  system. 

Figures  2.19  shows  the  discrete  time  response  of  pitch  normal 
acceleration  (n^)  which  has  a  0.5  seconds  time  constant,  steady-state  error 


Figure  2.19  Pilch  Normal  Acceleration  vs  Time,  Uncoupled  Pitch  Channel; 
Discrete  Open  Loop  System. 
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p 

about  0.005  and  2.0%  overshoot,  and  therefore  Is  according  to  the 

K<‘-‘ 

■y'-y 

1 

requirements  mentlonted  In  section  II.A. 

.  • 

Figures  2.20  and  2.21 

show  the  discrete  time 

responses  of  pitch 

( 

.*.■ 

L'.- 
L*  ' 

angular  rate  (q),  and  pitch  tall  incidence  (Sp).  These 

responses  matched 

■ 

i.'.- 
1  *  • 

those  presented  in  [Ref.  3].  An 

used  In  ail  cases. 

Input  step  function  representing  ‘1  gee*  was 

ft  .V.S 

Figures  2.22  through  2.24  show  the  discrete  Pole-Zero  Mops  of  n^,  q. 

•*' 

and  Sp  The  poles  are  found  to  be  at: 

P 

Z,  =0.1320  + J  0.03194 

(Acceleration  Filter) 

(II.C.5-t) 

i 

;;  ■ 

Z2  =  0.1320 -J  0.03194 

(Acceleration  Compensator)  (II.C.5-2) 

^  •*.  '* . 

Z3  =  0.8970  ♦  j  0.09067 

(Il.C.5-3) 

Z4  =  0.8970  -  j  0.09067 

(Angular  Rate) 

(II.C.5-4) 

1.  ^ 

•  J 

Zs  s  0.9536  ♦  j  0.02999 

(II.C.5-5) 

Z6  =  0.9536  -  j  0.02999 

(II.C.5-6) 

Z7  =  0.9982 

(II.C.5-7) 

Zq  =  1 .0000 

(Actuator) 

(II.C.5-8) 

•  i,  ■  ^ 

1 

Z9  =  0.9956  ♦  j  0.08307 

(Rote  Compensator) 

(II.C.5-9) 

p 

z,o=  0.9956  -  j  0.08307 

(Normal  Acceleration) 

(II.C.5-10) 

, 

»  • 

Since  all  the  poles  are  within  the  unit  circle  the  system  Is  stable. 

-  »’• 

The  zeros  of  the  discrete  pitch  normal  acceleration  ore  found  to  be  at; 

*>V-V' 

r- 

z,  =-0.4663 

(II.C.5-n) 

1 

Z2  =  0.1532 

(II.C.5-12) 

Z3  =  0.8466 

(II.C.5-13) 

*  •*  • 

Z4  =  1.1810 

(II.C.5-14) 

Zj  =  0.9214 

(II.C.5-15) 

•i, 
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26  = 

0.9982 

(II.C.5-16) 

2?  = 

1.0000 

(II.C.5-17) 

29  = 

0.9956  +  j  0.08307 

(II.C.5-18) 

29  = 

0.9956  -  j  0.08307 

(II.C.5-19) 

The  zeros  of  the  discrete  pitch  angular  rate  are  found  to  be  at: 


2i  =- 

2.2750 

(II.C.5-20) 

22  = 

0.1534 

(II.C.5-21) 

23  =- 

0.1386 

(II.C.5-22) 

24  = 

0.9985 

(II.C.5-23) 

25  = 

0.9214 

(II.C.5-24) 

26  = 

0.9982 

(II.C.5-25) 

27  = 

1.0000 

(II.C.5-26) 

ze  = 

0.9956  +  J  0.08307 

(II.C.5-27) 

29  = 

0.9956  -  j  0.08307 

(II.C.5-28) 

The  zeros  of  the  discrete  pitch  tall  Incidence  are  found  to  be  at: 


2,  =- 

0.4658 

(II.C.5-29) 

22  = 

0.1532 

(II.C.5-30) 

23  = 

0.9956  -  j  0.08307 

(II.C.5-31) 

Z4  = 

0.9956  +  j  0.08307 

(II.C.5-32) 

Z5  = 

0.9214 

(II.C.5-33) 

26  = 

0.9982 

(II.C.5-34) 

2?  = 

1.0000 

(II.C.5-35) 

Ze  = 

0.9956  ♦  J  0.08307 

(II.C.5-36) 

29  = 

0.9956  -  j  0.08307 

(II.C.5-37) 
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In  this  chapter  the  classical  design  of  the  continuous  uncoupled  pitch 
channel  autopilot,  as  was  developed  In  (Ref.  3],  was  reviewed,  and  the 
corresponding  discrete  channel  was  obtained  using  state-space 
representation  of  the  system  and  the  Analog-to-DIgItal  Conversion  option 
of  ORACLS. 

A  comparison  of  the  time  responses  In  the  s-domain  (Figures  2.7 
through  2.9)  with  those  In  the  z-domain  (Figures  2.19  through  2.21)  shows 
that  the  two  systems  behave  the  same  way.  In  addition  both  systems  are 
stable  as  It  can  be  seen  from  the  pole-zero  maps  of  the  continuous  system 
(Figures  2.13  through  2.15) ,  and  the  discrete  system  (Figures  2.22  through 
2.24) ,  since  their  poles  are  maping  according  to  relation  z=e*T 

The  similarity  of  the  continuous  and  discrete  systems  allow  us  from 
now  on  to  work  on  the  discrete  domain  without  any  loss  of  accurasy,  and 
using  the  computer  to  make  things  much  easier. 


III. 


UNCOUPLED  PITCH  CHANNEL  AUTOPILOT 


A.  GENERAL 

The  design  technique  for  the  uncoupled  pitch  channel,  as  developed  In 
iRef.  3],  was  classical  using  a  combination  of  frequency  response  and  root- 
locus  techniques. 

In  classical  control  theory,  only  the  Input,  output,  and  error  signals  are 
considered  Important;  the  analysis  and  design  of  control  systems  are 
carried  out  using  transfer  functions,  together  with  a  variety  of  graphical 
techniques  as  root-locus  plots  and  Nyquist  plots.  The  unique  characteristic 
of  classical  control  theory  Is  that  It  Is  based  on  the  Input-output  relation  of 
the  system,  or  the  transfer  function. 

The  main  disadvantage  of  classical  control  theory  Is  that,  generally 
speaking.  It  Is  applicable  only  to  linear  time-invariant  systems  having  a 
single  Input  and  a  single  output.  It  is  powerless  for  time-varying  systems, 
non-linear  systems  (except  simple  ones),  and  multiple-input-multiple- 
output  systems.  Thus  classical  techniques  (the  root-locus  and  frequency 
response  methods)  do  not  apply  to  the  design  of  optima)  and  adaptive  control 
systems,  which  ore  mostly  time-varying  and/or  linear. 

The  modem  trend  In  engineering  systems  Is  toward  greater  complexity, 
due  mainly  to  the  requirements  of  complex  task  and  good  accuracy.  Complex 
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systems  may  have  multiple  inputs  and  multiple  outputs  and  may  be  time- 
varying. 

Because  of  the  necessity  of  meeting  increasingly  stringent  requirements 
on  the  performance  of  control  systems,  the  Increase  In  system 
complexity, and  easy  access  to  large-scale  computers,  modern  control 
theory,  which  Is  a  new  approach  to  the  analysis  and  design  of  complex 
control  systems,  has  been  developed  since  around  1960.  This  new  approach 
Is  based  on  the  concept  of  state-space  representation. 

Modem  control  theory  Is  contrasted  with  classical  control  theory  in  that 
the  former  is  applicable  to  multiple-fnput-multiple-output  systems,  which 
may  be  linear  or  non-linear,  tlme-invaiiant  or  time-varying,  while  the 
latter  Is  applicable  only  to  linear  time-invaiiant  single-input-single-output 
systems.  Also,  modem  control  theory  Is  essentially  a  time-domain 
approach,  while  classical  control  theory  Is  a  complex  frequency-domain 
approach. 

System  design  In  classical  control  theory  Is  based  on  tiial-and-error 
procedures  which,  in  general,  will  not  yield  optimal  control  systems. 
System  design  In  modern  control  theory,  on  the  other  hand,  enables  the 
engineer  to  design  optimal  control  systems  with  respect  to  given 
performance  indexes.  In  addition,  design  in  modem  control  theory  can  be 
carried  out  for  a  class  of  Inputs,  instead  of  a  specific  Input  function,  such 
as  the  Impulse  function,  step  function,  or  sinusoidal  function.  Also,  modern 
control  theory  enables  the  engineer  to  include  initial  conditions  in  the 


The  equations  of  the  uncoupled  pitch  channel  autopilot  hove  already  been 
In  state-space  form  X  =  AX  +  BU  Jn  the  previous  chapter ,  and  therefore 
we  proceed  In  the  modem  control  design  of  the  discrete  state-feedback 
autopilot. 


B.  STATE  FEEDBACK  DESIGNED  AUTOPILOT 


One  of  the  attractive  features  of  state-space  design  methods  Is  that 
the  procedure  consists  of  two  independent  steps.  One  step  assumes  that  we 
have  all  the  states  at  our  disposal  for  feedback  purposes,  in  general,  of 
course,  this  would  be  unrealistic  since  a  practical  engineer  would  not,  as  a 
rule,  find  It  necessary  to  purchase  this  large  number  of  sensors,  especially 
since  he  knows  that  he  would  not  need  them,  using  classical  design  methods. 
The  assumption  that  all  states  are  available  merely  allows  us  to  proceed 
with  the  first  step,  namely,  the  control  law.  The  remaining  step  Is  to  design 
an  "estimator"  which  estimates  the  entire  state  vector,  given  measurements 
of  the  portion  of  the  state  provided  by  y  s  HX  +  JU. 

The  final  control  algorithm  wiii  consist  of  the  control  low  and  the 
estimator  combined  where  the  control-law  calculations  ore  based  on  the 
estimated  states  rather  than  the  actual  states.  This  substitution  is 
reasonable  and  the  combined  control  law  and  estimator  will  give  closed- 
loop  dynamic  characteristics  which  ore  unchanged  from  those  assumed  in 
designing  the  control  law  and  the  estimator  separately.  The  dynamic  system 
we  obtain  from  the  combined  control  law  and  the  estimator  is  called  the 
control ler.The  first  step  Is  to  get  a  good  control  law. 
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The  control  law  Is  simply  the  feedback  of  a  linear  combination  of  all 
the  states,  that  Is, 

U  =  -KX  (III.B.1-1) 

The  characteristic  equation  of  the  controlled  (closed  loop)  system  Is 
detl  Zl-A+BK  1  =  0  (III.B.1-2) 

The  control  law  design  then  consists  of  picking  the  elements  of  K  so 
that  the  roots  of  equation  III.B.1-2  are  In  desirable  locations. 

A  program  logic  for  application  of  Ackermann's  formula  to  compute 
the  control  law  Is  given  In  Appendix  C.  The  program  reads  In  the  sample  time 
T,  the  discrete  matrices  A  ,  B  and  the  desired  pole  locations  In  the  s-plane 
and  gives  as  output  the  control  law  matrix  K. 

The  program  used  In  this  work  was  written  In  WATFIV  computer 
language  and  Is  given  In  Appendix  D. 

In  section  III.C.5  utilizing  Analog-to-DIgltal  conversion  the  discrete 
uncoupled  pitch  channel  matrices  A  and  B  were  obtained.  Also  the  analysis 
of  the  continuous  open  loop  system,  obtained  from  OPTSYS,  showed  the 
eigenvalues  of  the  classical  design  to  be  at: 


St  =-159.724  + j  18.9921 

(III.B.1-3) 

$2  =  -159.724-  j  10.9921 

(III.B.1-4) 

S3  =  -8.29048  ♦  j  8.05932 

(III.B.1-5) 

S4  =  -8.29048  -  j  8.05932 

(III.B.1-6) 

S5  =-3.75925  + J  2.51463 

(III.B.1-7) 

S6  =-3.75925- j  2.51463 

(III.B.1-8) 

S7  =-0.14393000 

(ni.B.1-9) 

S9  =  -0.00000425 

(III.B.1-10) 

S9  =  -0.074593  ♦  j  6.65959  (III.B.  1-11) 

S,o=  -0.074593  -  J  6.65959  (III.B.  1-12) 

Utilizing  Ackermann's  formula  program  (Appendix  D)  and  using 
sample  time  T=  0.0125  sec  (80  cps),  the  discrete  matrices  A,B  (Appendix  B) 
and  desired  poles  locations  in  s-plane  the  continuous  open  loop  eigenvalues 
(equations  III.B.  1-3  through  IlI.B.1-12)  the  control  law  was  found  to  be: 

K  =  1-0.0188  -0.0279  -0.0042  0.0290  0.0041 

0.0  0.0001  1.7732  -2.0162  0.0131] 

(III.B.  1-13) 

Utilizing  Transfer  Function  Analysis  from  TRANFUNC  option  of 
ORACLS,  and  using  the  discrete  matrices  A,B  and  K  the  state-feedback 
autopilot  was  designed  and  analysed  according  to  step  responses  and  Pole- 
Zero  Mops. 

2.  Performance  of  System 

A  comparison  of  the  discrete  open  loop  eigenvalues  (det(  zl-A  jsO), 
obtained  using  the  Compensator  Transfer  Function  Analysis  from  TRANFUNC 
option  of  ORACLS: 


Z,  =0.131993  + j  0.0319377 

(III.B.2-1) 

Z2  =0.131993- j  0.0319377 

(III.B.2-2) 

Z3  =  0.096987  +  j  0.0906700 

(III.B.2-3) 

Z4  =  0.896987  -  J  0.0906708 

(III.B.2-4) 

Z5  =  0.953625  +  j  0.0299850 

(III.B.2-5) 

Z6  =  0.953625  -  J  0.0299050 

(III.B.2-6) 

Z7  =0.998202 

(III.B.2-7) 

28  2  1.000000 

(III.B.2-8) 
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29  =  0.995608  ♦  j  0.0830713  (III.8.2-9) 

2,0  =  0.995608  -  j  0.08307 1 3  (III.B.2- 1 0) 

with  the  closed  loop  regulator  eigenvalues  (det(  2l-A-^SK  ]=0) 
obtained  using  the  Transfer  Function  Analysis  from  TRANFUNC  option  of 
ORACLS: 


2,  =0.134462*  j  0.0320974 

(111.8.2-11) 

22  =0.134462- j  0.0320974 

(III.B.2- 12) 

23  =  0.896990  ♦  J  0.0906457 

(III.B.2- 13) 

24  =  0.896990  -  J  0.0906457 

(III.B.2- 14) 

25  =  0.953624  +  J  0.0299994 

(III.B.2- 15) 

26  =  0.953624  -  J  0.0299994 

(III.B.2- 16) 

27  =  0.998202 

(III.B.2- 17) 

2s  =  1.000000 

(III.B.2- 18) 

29  =  0.995608  +  j  0.0830713 

(III.B.2- 19) 

2,0  =  0.995608  - j  0.0830713 

(III.B.2-20) 

shows  no  significant  differences. 

Figures  3.1  through  3.3  show  the  discrete  closed  loop  time  responses 
of  pitch  normal  acceleration  (nj),  pilch  angular  rale  (q),  and  pitch  tail 
incidence  (5p).  An  input  step  function  representing  “1  gee"  was  used.  A 
comparison  of  the  responses  mentioned  above,  with  the  corresponding  time 
responses  of  the  discrete  open  loop  system  figures  2.19  through  2.21  shows 
that  they  are  identical. 

Figures  3.4  through  3.6  show  the  Pole-Zero  Mop  plots  of  n^,  q,  and  6p. 
All  the  poles, given  by  equations  III.B.2- 1 1  through  III.8.2-20,  are  inside  the 


unit  circle  and  the  system  is  stable.  There  are  no  real  2eros  in  the  system. 


TIME  -  SEC 


Figure  3.1  Pitch  Normal  Acceleration  vs  Time,  Uncoupled  Pitch  Channel; 
Discrete  State-Feedback  Autopilot. 
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In  the  previous  section  the  state-feedback  autopilot  was  designed 
using  the  feedback  gain  vector  (equation  III.B.1-13),  and  therefore  there 
were  ten  (10)  returning  gain  loops  making  the  system  more  complex.  In 
order  to  simplify  the  system,  zero  gains  were  introdused,  where  those  gains 
were  very  small  in  the  state  feedback  gain  vector,and  in  doing  so  returning 
gain  loops  were  eliminated  end  the  system  became  simpler. 

The  resulted  state-feedback  gain  vector  is; 

K  =  (-0.0108  -0.0279  0.0000  0.0290  0.0000 


0.0000 


0.0000  1.7732  -2.0162  0.0131] 


(III.B.3-1) 


Following  the  same  procedure,  as  in  the  case  of  State-Feedback 
Designed  Autopilot,  the  step  responses  and  Pole-Zero  Hap  plots  were 
obtained  and  analysed. 

The  pole  locations  of  the  simplified  state-feedback  autopilot  are 


found  to  be  at; 


Zi  =0.134450  + J  0.0321064 
Z2  =  0.134458-j  0.0321064 
Z3  =  0.896805  +  j  0.0911170 
Z4  =  0.896805-J  0.0911170 
Zj  =  0.953644  ♦  J  0.0290202 
Zj  =  0.953644  -  J  0.0290202 
Zf  =  0.998202 
Ze  =  1 .000000 

Z9  =  0.995608  +  J  0,0830713 


(III.B.3-2) 

(III.B.3-3) 

(III.B.3-4) 

(III.B.3-5) 

(III.B.3-6) 

(III.B.3-7) 

(III.B.3-8) 

(III.B.3-9) 

(III.8.3-10) 


2,0=  0.995608  -  J  0.00307 1 3  (III.B.3- 1 1 ) 

A  comparison  of  the  above  pole  locations  with  those  of  the  state- 
feedback  designed  autopilot  (equations  III.B.2-1 1  through  III.B.2-20)  show  a 
very  small  shifting  of  the  poles  of  the  simplified  state-feedback  autopilot 
to  the  left. 

0 

Figure  3.7  shows  the  time  response  of  the  pitch  normal  acceleration 
(ns)  for  the  simplified  state-feedback  autopilot.  An  Input  step  function 

representing  ‘1  gee"  was  used.  The  response  shows  that  the  steady-state 
error  Is  greater  than  in  the  case  of  state-feedback  autopilot  (Fig.  3.1),  but 
Is  whithin  the  requirements. 

Figures  3.8  and  3.9  show  the  time  responses  of  pitch  angular  rate  (q) 
and  pitch  tall  incidence  (6p)  for  the  simplified  state-feedback  autopilot.  A 

comparison  with  the  corresponding  time  responses  for  the  state-feedback 
autopilot  (Fig.  3.2  and  Fig.  3.3)  shows  no  significant  differences. 

Figures  3.10  through  3,12  show  the  Pole-Zero  Map  plots  of  n^,  q,  8p. 
All  the  poles,  given  by  equations  III.B.3-2  through  III.B.3- 1 1,  are  Inside  the 
unit  circle  and  the  system  Is  stable.  There  are  no  real  zeros  In  the  system. 


C.  ESTIMATOR  DESIGNED  AUTOPILOT 


The  control  law  designed  In  the  last  section  III.B  assumed  that  all 


states  were  available  for  feedback.  Since,  typically,  not  all  states  are 
measured,  an  estimator  must  be  design  In  order  to  estimate  all  the  states, 
given  measurements  of  a  portion  of  them.  If  the  state  is  X.  then  the 
estimate  is  and  the  idea  is  to  let  U  =  -L!^,  replacing  the  true  states  by 
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Figure  3.11  Pitch  Angular  Rate;  Uncoupled  Pilch  Channel; 

Discrete  Simplified  State-Feedback  Autopilot;  Pole-Zero  Mop. 
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their  estlmotes  in  the  control  low.  Figure  3.13  shows  an  open  loop  estimator 
and  Figure  3.14  shows  a  closed  loop  estimator. 

The  characteristic  equation  of  the  closed  loop  estimator  is; 

detl  zl-A+LH  1  =  0  (III.C.1-1) 

To  select  L.  we  take  the  same  approach  as  we  did  when  designing  the 
control  law  K. 

If  we  take  the  transpose  of  A-LH,  we  get  A^-H'^LT,  which  is  the  same 
form  as  the  system  matrix  A-BK  of  the  control  problem.  Therefore  If  we 
substitute  AT  for  A.  HT  for  B,  and  LT  for  K,  we  can  use  the  control  design 
results. 

Then  utilizing  Ackermann's  formula  program  (Appendix  0),  and  using 
sample  time  T=  0.0125  sec,  the  matrices  at  for  A,  HT  for  B,  where 

HT  =  I0  0  0  I  0  0  0  0  0  01 

(III.C.1-2) 

assuming  that  we  can  only  measure  the  state  X4  :  q,  and  taking  the 
desired  pole  locations  of  the  estimator  to  be  slightly  to  the  left  from  the 
original  open  loop  eigenvalues  (equations  III.B.1-3  through  III.B.1-12),  as 
shown  below: 


Si 

=  -159.729  + j  18.9921 

(III.C.t-3) 

S2 

=  -159.729- j  18.9921 

(III.C.1-4) 

=  -8.29548  +  J  8.05932 

(III.C.1-5) 

S4 

=  -8.29548  -  J  8.05932 

(III.C.1-6) 

ss 

=  -3.76425  + j  2.51463 

(III.C.1-7) 

H 

=  -3.76425-  J  2.51463 

(IIl.C.1-8) 

s? 

=  -0.148930 

(III.C.1-9) 

Plant 


Model 


Plant 


Model 


8g  =-0.005004 
S9  =  -0.079593  +  J  6.65959 
Sio  =  -0.079593  -j  6.65959 
we  obtain  the  estimator  gain  vector  : 
LT=I  -1.8784  0.0200  -0.09 


-0.0015  0.3860 


-0.0972  0.0219 


0.0720 


0.0007 


aii.c.1-10) 

(III.C.1-1 1) 
(III.C.l-12) 


0.0041 
-0.3370 ) 
(III.C.1-1 3) 


Utilizing  Compensator  Transfer  Function  Analysis  from  TRANFUNC 
option  of  ORACLS  and  using  the  matrices  A,  H  and  L  the  closed  loop 
estimator  autopilot  was  designed  and  analyzed  according  to  step  responses 
and  Pole-Zero  Maps. 


The  closed  loop  estimator  eigenvalues,  detl  zl-A+LH  ]  =  0,  obtained 
from  Compensator  Transfer  Function  Analysis  are: 

Zi  =0.140601  (III.C.2-1) 

Z2  =0.101457  (III.C.2-2) 

Zj  =  0.8970 1 8  +  J  0.0908305  (III.C.2-3) 

Z4  =  0.8970 1 8  -  j  0.0908305  (III.C.2-4) 

Z5  =  0.953599  +  J  0.0299821  (IlI.C.2-5) 

Z6  =  0.953599  -  J  0.0299821  (III.C.2-6) 

Z7  =  0.9956 1 9  ♦  j  0.0830597  (III.C.2-7) 

Zg  =  0.995619  -  J  0.0830597  (III.C.2-8) 

Zg  =0.998203  (III.C.2-9) 

z,o  =  0.999998  (III.C.2-10) 
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A  comparison  of  the  above  eigenvalues  with  those  of  the  closed  loop 
regulator  eigenvalues  det[  zl-A+BK  ]=0,  (equations  111.6.2-11  through 
111.6.2-20),  shows  an  acceptable  difference  since  we  estimated  the  entire 
state  vector  from  the  measurement  of  just  one  state,  namely  the  pitch 
angular  rate  (q),  and  we  moved  the  desired  pole  locations  of  the  estimator 
to  the  left  of  the  original  open  loop  eigenvalues.  In  order  to  get  a  faster 
response. 

Figures  3.15  through  3.17  show  the  discrete  closed  loop  estimator 
time  responses  of  pitch  normal  acceleration  (nj),  pitch  angular  rate  (q),  and 
pitch  tall  Incidence  (8p).  An  Input  step  function  representing  “1  gee"  was 
used.  A  comparison  of  the  responses  mentioned  above  with  the 
corresponding  time  responses  of  the  state-feedback  autopilot  Figures  3.1 
through  3.3  shows  no  differences.  This  Is  due  to  the  fact  that  the  same 
(zero)  Initial  conditions  was  used  for  both  cases. 

Figures  3.18  through  3.20  show  the  Pole-Zero  Map  plots  of  n^,  q  and  6p 

for  both  the  state-feedback  and  the  estimator  designed  autopilots.  All  the 
poles,  given  by  equations  III.C.2-t  through  III.C.2- 1 0,are  Inside  the  unit 
circle  and  the  system  Is  stable. 

The  zeros  of  the  estimator's  pitch  normal  acceleration  are  found  to  be 
at; 


Z,  =  0.1053 

(III.C.2- 11) 

Z2  =  0.8970  ♦  J  0.09080 

(III.C.2- 12) 

Zz  =  0.8970  -  j  0.09080 

(III.C.2- 13) 

Z4  =  0.1413 

(III.C.2- 14) 

Z5  =  0.9956  ♦  j  0.08307 

(III.C.2- 15) 
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Figure  3.15  Pitch  Normal  Acceleration  vs  Time;  Uncoupled  Pitch  Channel 
Discrete  Estimator  Autopilot. 
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Figure  3.17  Pilch  Toil  Incidence  vs  Time;  Uncoupled  Pilch  Channel; 
Discrele  Eslimalor  Aulopilol. 
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Figure  3.18  Pitch  Normal  Acceleration  ;  Uncoupled  Pitch  Channel;  Discrete 
State  Feedback  and  Estimator  Autopilots;  Pole-Zero  hop. 


Figure  3.19  Pilch  Angular  Role;  Uncoupled  Pilch  Chonnel;  Discrele  Slole 
FeedPock  and  Eslimalor  Aulopilols;  Pole-Zero  Map. 


Figure  3.20  Pitch  Toil  Incidence;  Uncoupled  Pitch  Channel;  Discrete 
State  Feedback  and  Estimator  Autopilots;  Pole-Zero  Map. 
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26  =  0.9956  -  J  0.08307 

(III.C.2-16) 

Z7  =  0.8468 

(III.C.2-17) 

Zg  =  1.0000 

(III.C.2-18) 

Z9  =  0.9982 

(III.C.2-19) 

zeros  of  the  eetimetor's  pitch  engutor  rote  ore  found  to  be  ot; 

z,  =  0.9956  ♦  j  0.08307 

(III.C.2-20) 

Z2  =  0.9956  -  J  0.08307 

(III.C.2-21) 

z,  =  0.8970  ♦  J  0.09081 

(ni.C.2-22) 

24  =  0.8970- j  0.09081 

(III.C.2-23) 

25  =  1.0000 

(ni.C.2-24) 

Zg  =  0.1056 

(III.C.2-25) 

27  s  0.9982 

(III.C.2-26) 

29  =  0.9536  ♦  J  0.02998 

(III.C.2-27) 

29  =  0.9536  -  J  0.02998 

(III.C.2-28) 

zeros  of  the  estimator's  pitch  toil  Incidence  are  found  to  be  at: 

Zi  =  0.9958  ♦  J  0.08305 

(III.C.2-29) 

Z2  =  0.9958  -  J  0.08305 

(III.C.2-30) 

Z3  =  0.9536  ♦  j  0.02997 

(III.C.2-31) 

Z4  =  0.9536  -  j  0.02997 

(III.C.2-32) 

Zj  =  0.1413 

(lII.C.2-33) 

Z6  =  1.0000 

(III.C.2-34) 

Z7  =  0.9982 

(III.C.2-35) 

Zg  =  0.8970*  J  0.09081 

(III.C.2-36) 

Z9  =  0.8970- J  0.09081 

(III.C.2-37) 
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For  the  same  reason,  as  In  the  case  of  simplified  state-feedback 
autopilot.  In  order  to  eliminate  returning  loops  In  the  design  of  simplified 
estimator  autopilot,  zero  gains  were  introduced  where  the  gains  of  the 
estimator  (equation  III.C.1-13)  were  very  small.  Then  the  resulted  gain 
vector  Is: 

LT=(  -1.8784  0.0200  -0.0972  0.0219  0.0000 

0.0000  0.3860  0.0720  0.0000  -0.3370 1 

(III.C.3-1) 

Following  the  same  procedure,  as  In  the  case  of  the  Estimator 
Designed  Autopilot,  the  time  responses  and  Pole-Zero  hap  plots  were 
obtained  and  analyzed. 

The  pole  locations  of  the  simplified  estimator  autopilot  are  found  to 

be  at: 


Z,  =0.140707 

(III.C.3-2) 

Z2  =0.101090 

(III.C.3-3) 

Zz  =  0.896885  ♦  J  0.0938778 

(III.C.3-4) 

Z4  =  0.896885  -  J  0.0938778 

(III.C.3-5) 

Z5  =  0.953882  ♦  j  0.0288601 

(III.C.3-6) 

Z6  =0.953882- J  0.0288601 

(III.C.3-7) 

Z7  =  0.995605  ♦  J  0.0830655 

(III.C.3-8) 

Zg  =  0.995605  -  J  0.0830655 

(III.C.3-9) 

Z9  =0.998202 

(III.C.3-10) 

z,o  =  0.999985 

(III.C.3-11) 

A  comporison  of  the  above  pole  locations  with  those  of  the  estimator 
designed  autopilot  (equations  III.C.2-1  through  III.C.2-10)  shows  no 
significant  differences. 

Figures  3.21  through  3.23  show  the  simplified  closed  loop  estimator 
time  responses  of  pitch  normal  acceleration  (n^),  pitch  angular  rate  (q),  and 
pitch  tall  Incidence  (Sp).  An  Input  step  function  representing  ”1  gee"  was 
used.  A  comparison  of  the  above  responses  with  the  corresponding  time 
responses  of  the  estimator  designed  autopilot  (Figures  3.15  through  3.17) 
shows  no  significant  differences. 

Figures  3.24  through  3.26  show  the  Pole-Zero  Map  plots  of  Oz,  q  and  Sp 
for  the  simplified  estimator  designed  autopilot.  All  the  poles,  given  by 
equations  III.C.3-2  through  III.C.3-1  t,are  Inside  the  unit  circle  and  the 
system  Is  stable.  There  are  no  significant  differences  in  the  zero's 
locations  from  those  of  the  estimator  autopilot  (equations  III.C.2-n 
through  in.C.2-37). 
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Figure  3.21  Pitch  Normal  Acceleration  vs  Time;  Uncoupled  Pitch  Channel; 
Discrete  Simplified  Estimator  Autopilots. 
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Figure  3.22  Pitch  Angular  Rate  vs  Time,  Uncoupled  Pitch  Channel; 
Discrete  Simplified  Estimator  Autopilot. 
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Figure  3.24  Pilch  Normal  Acceleration ,  Uncoupled  Pilch  Channel; 

Discrete  Simplified  Estimator  Autopilot;  Pole-Zero  Mop. 
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Figure  3.26  Pitch  Toil  Incidence;  Uncoupled  Pitch  Chonnel; 

Discrete  Simplified  Estimator  Autopilot;  Pole-Zero  Map. 
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The  control  design  procedures  described  in  chepter  II  end  III  were  applied 
to  systems  with  one  input  and  one  output.  The  transfer-function  approach  in 
(Ref.  3]  is  fundamentally  limited  to  single  input/output  systems  while  the 
state-space  methods  of  chapter  III  were  limited  to  single  input/output  to 
simplify  the  procedures.  In  fact,  if  one  tries  to  apply  the  'pole-placement" 
approach  of  chapter  III  to  a  multivariable  (more  than  one  input  or  output) 
system,  all  the  procedures  work  but  the  gains,  K  or  L,  are  not  uniquely 
determined  by  the  resulting  equations.  Until  a  design  approach  is  available 
which  intelligently  uses  this  extra  freedom,  the  pole-placement  concept  for 
estimator  designs  for  systems  with  more  than  one  output  or  for  controller 
designs  for  systems  with  more  than  one  input  has  limited  value. 

In  this  chapter  the  pole  placement  and  robustness  design  program 
(POPLAR),  [Ref.  8|  was  used  as  a  tool  in  the  design  of  multivaiiable  systems. 
This  program  is  designed  to  employ  singular  value  analysis  and  the  use  of  an 
optimization  to  aid  in  pole  placement  control  system  design  for  linear 
multivariable  systems.  Robustness  of  the  system  is  also  considered  by 
establishing  singular  value  levels  which  correspond  to  multiloop  gain  and 
phase  margins  determined  from  the  universal  gain  phase  diagram  developed 


0.  DESIGN  APPROACH  AND  ANALYSIS  OF  THE  DISCRETE  STATE 
FEEDOACK  AUTOPILOT 

The  first  step  In  any  multivariable  design  should  be  an  attempt  to 
find  an  approximate  model  consisting  of  two  or  more  single  input/output 
model  or  else  decouple  the  control  law  matrix  K  and  the  estimator  law 
matrix  L  This  step  will  give  better  physical  Insight  Into  the  Important 
feedback  variables  and  may  lead  to  a  plant  description  which  is 
substantially  simpler  for  design  purposes  and  yet  yields  no  significant 
degradation  from  an  analysis  based  on  the  full  multivariable  system. 

Combining  the  pitch  and  roll  channel  autopilot,  the  roll  channel  taken 
from  (Ref.  71.  a  seventeenth  (17^^)  order  system  is  obtained  and  is  shown  in 
Appendix  E. 

Utilizing  Transfer  Function  Analysis  from  TRANFUNC  option  of  ORACLS 
and  using  the  combined  pitch  and  roll  matrices  A.  B  and  K  the  discrete 
closed  loop  system  was  obtained  and  analyzed  according  to  time  responses 
and  Pole-Zero  Map  plots. 

C.  PERFORMANCE  OF  SYSTEM 

The  discrete  state-feedback  eigenvalues.  det(  zl-A+BK]=0.  of  the 
coupled  system,  obtained  from  Transfer  Function  Analysis  option  of 
ORACLS.  are: 


Z,  =  0.134462  ♦  j  0.0320974 

(IV.C-1) 

Z2  =  0.134462  - j  0.0320974 

(IV.C-2) 

Zz  =  0.896990  ♦  j  0.0906457 

(IV.C-3) 

Z4  =  0.896990  -  j  0.0906457 

(rv.c-4) 

Z5  =  0.953624  ♦  j  0.0299994 

(IV.C-5) 

Z6  =  0.953624  -  J  0.0299994 

(IV.C-6) 

Z7  =  0.996202 

(IV.C-7) 

Zg  =  1.000000 

(IV.C-8) 

Z9  =  0.995608  +  j  0.0830713 

(IV,C-9) 

Zio=  0.995608- j  0.0830713 

(IV.C-10) 

Zn=  0.0993086 

(IV.C-1 1) 

z,2=  0.836553  +  j  0.306107 

(IV.C-1 2) 

z,3=  0.836553  -  j  0.306107 

(IV.C-1 3) 

Zh=  0.967788  +  j  0.0334452 

(IV.C-1 4) 

Zi3=  0.967788  -  j  0.0334452 

(IV.C-1 5) 

Zi6=  0.895730 

(IV.C-1 6) 

Zn=  0.938133 

(IV.C-1 7) 

Since  all  the  poles  are  Inside  the  unit  circle  the  coupled  system  is 
stable. 

Figures  4.1  through  4.3  show  the  closed  loop  time  responses  of  pitch 
normal  acceleration  (n^),  pitch  angular  rate  (q)  and  pitch  tail  incidence  (6p), 

An  input  step  function  representing  "1  gee"  was  used.  All  the  responses  are 
identical  to  those  obtained  for  the  uncoupled  pitch  channel  and  therethore 
they  meet  the  desired  requirements. 

Figures  4.4  through  4.6  show  the  Pole-Zero  Map  of  n^,  q  and  5p 
respectively.  The  poles  of  the  system  are  given  by  equations  IV.C-1  through 
IV  C-17  and  they  are  the  same  as  the  uncoupled  closed  loop  poles  (equations 
III.B.2-1 1  through  III.B.2-20).  There  are  no  real  zeros  in  the  state  feedback 
coupled  system. 
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D.  ROBUSTNESS  OF  SYSTEM 

With  the  rising  Interest  In  multWerlable  control  theory  brought  on  by 
incresslngty  complex  systems  the  need  has  arisen  to  develop  design  methods 
that  will  allow  the  designer  to  specify  system  performance  while  at  the 
same  time  ensuring  relatively  high  stability  margins  or  robustness.  In  the 
single-input-single-output  (SISO)  case  the  designer  has  had  the  tools  to  do 
these  tradeoffs  in  the  form  of  Nyquist,  Bode  and  root-locus  plots.  In  the 
multl-input-multl-output  (MIMO)  case  the  classical  methods  are  not  totally 
appropriate. 

With  the  Increased  Interest  In  MIMO  systems  numerous  methods  of  design 
have  been  employed  to  obtain  suitable  system  performance  and  robustness 
with  varying  degrees  of  success.  One  primary  method  of  design  Is  to  keep 
the  plant  as  decoupled  as  possible  throughout  the  design  so  that  each 
Individual  element  may  be  controlled  Independently  and  designed  essentially 
as  a  single  loop  system.  In  another  procedure  the  multlloop  system  Is 
modified  Into  a  system  that  has  diagonal  elements  that  are  much  larger  than 
any  off-diagonal  elements.  This  diagonally  dominant  system  Is  then  In  a 
form  where  conventional  Nyquist  type  techniques  can  be  employed  In  the 
analysis.  A  third  common  MIMO  design  method  Is  that  of  the  Linear  Quadratic 
(LQ)  method.  This  method  uses  a  quadratic  cost  functional  and 
optimamizatlon  principles  to  allow  the  designer  to  design  for  various 
performance  levels  by  adjusting  the  matrix  weighting  terms  used  in  the 
cost  function.  The  major  difficulty  with  all  of  the  above  methods  is  that 
they  are  not  necessarily  robust.  This  Is  especially  true  for  cross-coupling 
terms  between  loops. 
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A  Simple  Interpretation  of  robustness  Is  the  ability  of  a  system  to 
tolerate  design  pertubatlons.  These  pertubatlons  could  be  In  the  form  of 
actuator  failures,  plant  parameter  uncertainty,  unmodeled  dynamic  or 
nonlinear  terms,  or  any  one  of  many  other  pertubatlons  to  the  nominal 
design  of  the  system. 

The  analysis  of  the  robustness  of  the  system  was  obtained  using  the  Pole 
Placement  and  Robustness  Design  Program  (POPLAR)  developed  in  iRef.  8}. 

Utilizing  the  above  program  and  using  the  data  file  shown  In  Appendix  F 
for  the  state  feedback  autopilot,  and  the  data  file  shown  In  Appendix  G  for 
the  estimator  autopilot,  the  system  found  to  be  robust. 

Figures  4.7  and  4.8  show  the  Minimum  Additive  Output  Singular  Value 
(SVAOMO)  vs  frequency  for  the  state  feedback  and  estimator  designed 
autopilots  respectively.  It  Is  noted  that  for  very  low  frequencies  the  values 
of  SVAOMO  are  above  0.80680  and  0.83976  for  each  of  the  designs. 

Figures  4.9  and  4.10  show  the  Minimum  Additive  Input  Singular  Value 
(MIN.ADD.IN.SV)  vs  frequency  for  the  state  feedback  and  estimator  designed 
autopilots  respectively. 

In  the  case  of  state  feedback  autopilot  the  ordered  complex  eigenvalues 
(Input),  and  the  ordered  computed  eigenvalues  (output)  are; 

Ordered  lnQy\  Qrder.ad 

-0.01000  + j  1.00000  0.09931 

0.09928  0.13446- j  0.03210 

0.13199- J  0.03194  0.13446  ♦  J  0.03210 

0. 1 3 1 99  ♦  j  0.03 1 94  0.83653  -  J  0.306 1 0 

0.83522  -  J  0.30974  0.83653  ♦  j  0.306 1 0 
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SVADMO 

0.900  0,925  0.950  0.975  1.000  1.025  1.050 


.639 


KtPUOUin  l  D  A  I 


0.03522  ♦  J  0.30974 

0.89571 

0.89380 

0.89690  -  j  0.09064 

0.89699  -  j  0.09067 

0.89698  +  j  0.09064 

0.89699  ♦  J  0.09067 

0.93813 

0.95363  -  J  0.02998 

0.95360  -  J  0.03001 

0.95363  +  j  0.02998 

0.95360  ♦  j  0.03001 

0.96909  -  J  0.03286 

0.96776  -  J  0.03345 

0.96909  ♦  J  0.03286 

0.96776  ♦  J  0.03345 

0.99561  -  j  0.08307 

0.99559  -  j  0.08307 

0.99561  +j  0.08307 

0.99559  *  J  0.08307 

0.99820 

0.99020 

1.00000 

1.00000 

In  the  case  of  the  estimator  autopilot  the  ordered  complex  eigenvalues 
(Input)  are  the  same,  as  In  the  state  feedback  autopilot,  and  the  ordered 
computed  eigenvalues  (output)  are; 

Ordered  output  eigenvalues 

0.07717 

0.09855 

0.25923 

0.69500 

0.83707*  j  0.30140 
0.03707  -  j  0.30 140 
0.89849 
0.90064 
0.93996 
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A.  CONCLUSIONS 

The  goal  of  this  thesis  was  to  design  and  analyze  the  discrete 
longitudinal  autopilots  for  BTT  and  STT  missiles. 

The  following  are  the  principal  conclusions  based  on  this  work. 

1.  The  continuous  and  discrete  longitudinal  autopilots  were  proved  to 
have  Identical  performances. 

2.  The  State-Feedback  and  Estimator  autopilots  were  introduced  as 
additional  dynamic  designs  In  order  to  Implement  control  Into  the  original 
system.  Both  performances  were  found  to  meet  the  desired  requirements. 

3.  The  Simplified  State-Feedback  and  Estimator  autopilots  reduced  the 
compleNity  of  the  system,  by  eliminating  returning  gain  loops,  and  without 
any  significant  effects  on  the  system's  performance. 

4.  The  performance  of  the  Coupled  Pitch  and  Roll  channel  autoplloto  was 
found  to  be  satisfactory  and  also  proved  to  be  robust. 

0.  RECOMMENDATIONS 

In  order  to  moke  the  whole  design  even  simpler  more  returning  gains 
loops,  of  the  Simplified  State-Feedback  and  Estimator  autopilots,  must  be 
eliminated.  A  further  Investigation  then  must  be  conducted  In  order  to 
examine  whether  the  performance  of  the  resulting  design  remain  unchonge. 
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GEOMETRIC  AND  MASS  PROPERTIES  OF  MISSILE 


Weight  (lbs) 

Maximum  Diameter  (In) 


Length  (In) 
Ixx  (Slug  Ft2) 
lyy  (Slug  Ft2) 
Ia(SlugFt2) 


Center  of  Gravity  Distance  from  Nose  (In) 
Reference  Length  (Ft) 

Reference  Area  (Ft2) 
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2525 

24 

168 

40 

804 

810 

100.8 
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APPENDIX  C 


PROGRAM  LOGIC  FOR  COMPUTING  CONTROL  LAW  K  VIA  ACKERMANN'S  FORMULA 


1 .  Read  In  A,  B,  J,  and  N,,  the  number  of  states. 

2.  Comment:  first  we  will  read  In  the  desired  pole  location  In  the 
plane, convert  them  to  z*plane  polynomial  coefficients,  and  construct 
a(A). 

3.  I  Identity  matrix,  N,  x  N, 

4.  ALPHA  I 

5.  k  ^  \ 

6.  If  k>  N,,  go  to  step  18. 

7.  Read  In  pole  location  k  as  a+Jb. 

8.  If  bsO,  go  to  step  14. 

9.  At  -2  exp(oT)cos(bT) 

10.  A2  ♦  exp(2oT) 

11.  ALPHA  ^  ALPHA  x(A  X  A  ♦  A,A  ♦AjI) 

12.  k  <■  k  +  2 

13.  Go  to  step  6. 

14.  At  exp(oT) 

15.  ALPHA  ^  ALPHA  X  (A  -  At  X  I) 

16.  k  k  +  1 

17.  Go  to  step  6. 

18.  Comment:  now  we  construct  the  controllability  matrix. 


E  ♦  B 

k  ♦  1 

If  k  >  N,,  go  to  step  28. 

Comment:  replace  column  k  of  C  by  E. 
Cl  ;  kl  E 
k  ♦  k+  1 
E  *<•  A  X  E 


Go  to  step  22. 

Comment:  now  solve  for  the  control  law,  first  form  e^^  as  the  last 

row  of  I 
E  ^  IIN,;  ] 

Solve  DC  s  E  for  D. 

K  =  D  X  ALPHA 


ooo  rto  o  o  ooo 
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Lt:  ACKErtMA.-,  nATrlV  A1 


INreOEK  ^lS.^,iA.  lE^.I  .J.\t 

a£At  PH  )  .  liAl  20,2  j  J  .AI  I  20,  20  J,  ALA-u  ^2  3,^3)  ,  i.nl  4J) 

A£AL  A2  ,cl2^,4-j),^(2G,23),ji20l,  ar*  (^J,2  J)  ,oAi2J,2J} 

RtAL  A.a.T,  R, ATtHr I  20. 20i 

real  m1  ,  Tul2o  ,2u)  ,  I II  2 0,201  .  Ti  (  20,2  J>  .  w  I2C.2C  I ,  TX  (2  J  ,20  I 

INPUT  OF  NS«  \J>*3EI  3T^T  lO 
I»  SaPPLc  i  lOt 

PRINT  ,  ■  cMER  NUFOER  OF  SIATEi.’ 

REAU,  NS 

PRINT,  •  ENTER  SAMPLE  TIME  * 

REAJ,  T 

INPUT  jF  PnI=A  MATkIx 
00  100  1  =  1. '.i 
QC  IJl  J=l...S 
MRI  TE(  a  ,103  I  I,J 

103  FORMAT  (  AX,  •  c‘,  lErs  PHI  •  ,  12  ,  •  ,  12.  •  I 

REAO.Pnl 1. J I 

101  continue 

lUO  ClmNIINUE 

INPUT  OF  0A=  3  mat:;  IX 
OC  200  1=1 .NS 

0  =  1 

MHIT£(6,105)  I.J 

155  format  1  AX, '  cnTEa  OAI  •  ,12  , ,  12,  • )  •  ) 

REA0,0A ( I ,0  J 
200  CwNTiNuE 

aUlLJlNO  TrE  lOENTITY  MATRIX 
A4.PHA»C  =  1 

00  1  I*  I,. NS 
00  5  0=  1,  Ni 
IF  I  1  .E  O.J  )  UC  7C  300 
A  U  I  ,  J  I  =0 , 

AlPi^AI  I  ,j|  =  0  . 

C  1 1  ,01  =  0. 

OU  T^  5 

300  Ail  I,wl=l. 

ALPHA!  1  .01  =  1  . 

Cli.OI=l, 

5  continue 

1  CONTINUE 

N  =  1 

,6  IF  IK,wT,N3J  Ou  To  13 

IT, PUT  OF  OEaIrEO  PULE^  LOCATIU'I 


■  RITE  (6, A3  I 

FURMAIl*  ENTER  rvEAL  PAaT  OF  JESIKEJ  PuLE  lOCATIuN.'I 

REAj.A 

XK  I  T  E  1  (,  .-.A  I 

FGaMAII*  cNIER  IMAOINAKY  PART  OF  JcSIlED  PULE  LCCATION.'l 


REAQ.o 

UUlLOliNO  ALPHA  I  PH  1 1 

IF  I  a  .Ew.JI  GG  TO  I A 
A  I*  -2  .  *  EXP  I  -  •  T  )  “LG  S I  o*n 
A2«exP( 2.=A*IJ 
Evaluate  pm»phi 

CALL  VMULFF  lPH,PH,.,3,N3,.NS,2U,20,rN,20,  IL;r) 

00  2  I  =  1,NS 
Ou  a  0=1, Nj 

Tull  .  J)»Ph(  I,  j)  =  A1 
T  I  I  1  ,  Jt>Al  (  I,  0  )«A2 
Tjll,j|  =  lMil,JJ,Tu(I.JJ«^Tl(1.0  1 
3  C  ON  T  I  iNU  c 

2  CONTINUE 

CALL  VMjLFF  (  alpha,  IS.  .N3,.NS.NS. 20,20, ATEHP,  23  ,  1 1  R) 
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